q=rand(4,1);
qp=rand(4,1);
qpp=rand(4,1)
m5=3;
iext=0.05*eye(3);
tau=newtoneuler6(q,qp,qpp,9.8,m5,iext)
acel=WalkerOrin6(q,qp,tau,m5,iext)